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@) DISPOSITIF DE CAPTURE DES MOUVEMENTS DE ROTATION D'UN SOLIDE 



(^ La presents invention conceme un disposltif de captu- 
re de rorientation d'un solide comprenant: 

- au moins un capteur (10a, 10b) de position anguiaire, 
susceptible d'etre rendu solidaire du solide et de delivrer au 
moins una donnee de mesure representative de 
rorientation du solide, 

- un moyen (14) generateur de donnees de test (0t) re- 
presentatives d'une orientation estimee du solide, 

- un moyen (18) de modification de ('orientation estimee 
du solide par confrontation de la donnee de mesure et de 
donnees de test. 

Application aux peripheriques de salsle pour I'informatl- 
que, au domaine-medical. 
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DISPOSITIF DE CAPTURE DES MOUVEMENTS DE ROTATION D'UN 

SOLIDE . 

Domaine tiechniaue 
5 La presente invention concerne un dispositif et 

un procede de capture de 1 ' orientation et du mouvement 
de rotation d'un solide. Les dispositif s de capture du 
mouvement, parfois designes par « mocap (de « motion 
capture » en anglais) trouvent des applications dans 

10 des domaines 'aussi varies que les domaines de la sante, 
le multimedia, la recherche miniere ou la geophysique. 

Dans le domaine d' application des jeux ou des 
simulations video, les mouvements d'un utilisateur 
peuvent en effet §tre enregistres pour la commande de 

15 systemes immersifs de realite virtuelle. A titre 
d'exemple, les mouvements d'un joueur peuvent etre 
enregistres pour commander 1' evolution d'un personhage 
virtuel dans une scene de synthese, 

Dans le domaine de la sante, les dispositif s de 

2 0 capture de mouvement peuvent etre utilises pour 
positionner un outil de chirurgie ou bien pour 
surveiller 1* evolution de 1 ^ autonomie des personnes 
fragiles en rendant compte de leur activite physique. 

Dans le domaine de 1 ' electronique portable, les 

25 dispositifs de capture de mouvement permettent aux 
appareils de s' adapter au contexte d * utilisation. lis 
permettent, par exemple, d'optimiser la reception, d'un 
telephone portable par la connaissance de son 
orientation, ou d'ameliorer les interfaces des 

30 assistants personnels. 
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Etat de la technique anterieure 

Les capteurs de mouvement , et plus precisement 
les capteurs de position angulaire, sont fortement 
miniaturises et font I'objet de recherches pour leur 
conferer une robustesse et un cout compatibles avec des 
applications visant le grand public. 

La position d-un solide dans I'espace est 
enti^rement determinee par la connaissance de six 
grandeurs.. Parmi celles-ci on distingue trois grandeurs 
susceptibles de traduire des translations et trois 
autres grandeurs susceptibles de traduire des 
rotations. Les trois dernieres grandeurs correspondent 
a des positions angulaires. Celles-ci peuvent etre 
utilisees pour determiner des mouvements dits de lacet 
de tangage et de roulis. 

Selon les applications envisagees, il n'est pas 
tou jours necessaire de disposer de 1' ensemble des six 
grandeurs associees a six degres de liberte. Un norabre 
plus restreint de donnees peut en effet suffire dans un 
■grand nombre de cas . 

On . connait principalement deux types de 
capteurs susceptibles de detecter la position angulaire 
ou la rotation d'un solide. II s'agit d'une part des 
capteurs sensibles a un champ magnet ique, tels que les 
magnetometres , et d' autre part des capteurs sensibles a 
une acc§l€ration, tels que des accelerometres . De fagon 
avantageuse, les accelerometres peuvent mesurer des 
accelerations quelconques du solide, done par exemple, 
des modifications de 1 ' orientation du solide par 
rapport a la direction du champ de gravite terrestre . 
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Les magnetometres peuvent etre utilises en 
combinaison avec une source de champ magnet ique 
artif icielle . On prefere toutefois faire appel a des 
magnetometres susceptibles de detecter 1 ' orientation du 
5 solide par rapport au champ magnetique terrestre. On 
considere bien sur que les directions du champ 
magnetique et de 1 ' acceleration de la pesanteur ne sont 
pas colin^aires. 

Les capteurs peuvent etre du type a axe unique, 
10 c'est-a-dire sensibles selon une direction unique de 
I'espace. Cependant, on utilise de preference des 
capteurs a deux ou a trois axes non paralleles. Ceux-ci 
delivrent alors. des valeurs de mesure permettant de 
connaitre de fagon complete une position angulaire d'un 
15 solide dont ils sont solidaires. 

Les capteurs delivrent un signal de mesure M 
qui est reliS ^ leur inclinaison I par une fonction f 
telle que : 

M=f (1) . 

20 L' inclinaison est consideree ici par rapport a 

une position angulaire de reference. Celle-ci peut etre 
arbitraire ou ajustee sur le champ magnetique ou le 
champ de gravitation terrestre. La grandeur que 1 ' on 
souhaite connaitre est 1 ' inclinaison I. Celle-ci peut 

25 etre retrouvee par calcul selon une f ormule I = f (M) . 

La fonction inverse f"^ est cependant difficile 
a etablir avec exactitude. De plus, elle souffre de 
discontinuites et de non-linearites . Une difficulte 
tient par exemple au fait que les capteurs utilisant le 

3 0 champ de la pesanteur permettent certes de retrouver a 
tout instant des rotations autour d'axes horizontaux 
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mais non autour de la direction de la pesanteur. II en 
va de meme pour les tnagnetometres qui ne sont efficaces 
que pour mesurer des rotations dont 1 » axe n'est pas 
confondu avec la direction du champ magnetique utilise 
comme reference. Des non-linearites proviennent aussi 
des ionctions trigonometriques mises en jeu par le 
calcul de la fonction inverse. 

Des inexactitudes supplementaires proviennent 
du fait que les capteurs a trois axes ne pr^sentent pas 
toujours une relation angulaire tres precise entre les 
axes. Par exemple, les axes ne sont pas exactement 
orthogonaux . 

Une illustration de I'etat de la technique peut 
encore etre trouvee dans les documents (1) a (4) dont 
les references sont precisees a la f in de la presente 
description. 

Expose de 1^ invention 

L' invention a pour but de proposer un 
dispositif et un precede de capture de 1 ' orientation 
d'un solide ne presentant pas les limitations et 
difficultes evoquees ci-dessus. 

Un but est en particulier de proposer un tel 
dispositif qui soit peu couteux et susceptible d'etre 
integre dans des equipements destines a un large 
public • 

Un but est encore de proposer un dispositif 
fiable, peu sensible a des phenomdnes de non-linearite 
affectant les mesures, et permettant de prendre en 
compte directement d' eventuelles imperfections des 
capteurs . 
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Pour atteindre ces buts,. 1' invention concerne 
plus precisement un dispositif de capture de 
1' orientation d'un solide comprenant : 

- au moins un capteur de position angulaire susceptible 
5 d'etre rendu solidaire du solide et de delivrer au 

moins une donnee de mesure representative de 
1 ' orientation du solide, 

— un moyen generateur de donnees de test 
representatives d'une orientation estimee du solide, 

10 — un moyen de modification de 1 ' orientation estimee du 
solide par confrontation de la donnee de mesure et de 
donnees de test . 

Dans la description qui suit, il est fait 
2fgf^i-ence a 1 ' orientation d'un solide. Le solide ne 

15 fait cependant pas partie du dispositif de capture ► 
L' orientation correspond plus precisement a celle du ou 
des capteurs susceptibles d'etre fixes au solide. Par 
ailleurs, les termes orientation et position angulaire 
sont utilises comme synonymes . Grace au dispositif de 

20 1' invention, il est possible d'af finer successivement 
1' estimation de 1 ' orientation du solide. 

Apres une ou plusieurs modifications de 
1 ' orientation estimee, celle-ci converge vers 
1 ' orientation effective du solide, ou, plus 

25 precisement, vers 1 ' orientation mesuree. Ainsi, le 
dispositif de 1' invention ne necessite pas de moyens de 
calcul pour etablir 1 ' orientation ou 1 ' inclinaison du 
solide sur la base d'une fonction (inverse) des donnees 
de mesure des capteurs. 

30 Le dispositif de 1' invention permet de prendre 

directement en compte les imperfections des capteurs et 
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peirmet de s'affranchir des comportements' non lineaires 
de ceux-ci. A titre d' example, 1 ' ut il isation de 
capteurs a trois axes sensibles non orthogonaux est 
possible. 

Selon une realisation particuliere du 
dispositif , les moyens de modification de 1 ' orientation 
estimee peuvent comporter un premier comparateur relie 
d»une part au capteur et d' autre part au moyen 
generateur de donnees de test . Le premier comparateur 
reqoit ainsi la dpnnee de mesureet une donnee de test, 
et peut etablir au moins une difference entre la donnee 
de test et la donnee de mesure. 

La difference entre la donnee de test et la 
donnee de mesure const itue une mesure de la pertinence 
de 1' orientation estimee. 

La correlation entre 1 ' orientation estimee et 
la donnee de test generee peut etre donnee, par 
exemple, par une fonction directe f telle qu'evoquee 
dans la partie introductive de la description. II 
s'agit, par exemple, d'une simple fonction de 
modelisation du comport ement des capteurs. 

La difference entre chacune des donnees de test 
successives et la donnee de mesure peut aussi etre mise 
a profit pour controler la necessite ou non d' af finer 
encore 1 ' orientation estimee. Ainsi, le dispositif peut 
comporter un deuxieme comparateur a seuil pour comparer 
la difference etablie par le premier comparateur a une 
valeur de seuil et pour valider 1 ' orientation . estimee, 
lorsgue la difference etablie par le premier 
comparateur pour une valeur de test donnee est 
inf erieure a la valeur de seuil . 
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Lorsque la difference reste trop importante una 
nouvelle estimation de 1 ' orientation est entreprise. 

Les moyens de modification de 1 ' orientation 
estimee et/ou les moyens generateurs d'une donnee de 
test peuvent comporter un calculateur pour etablir une 
nouvelle orientation estimee et/ou une nouvelle donnee 
de test selon une methode dite de descente de gradient 
d' erreur . 

Par ailleurs, les moyens g#n6rateurs de donnees 
de test peuvent comporter un calculateur pour calculer 
des donnees de test en fonction d'une orientation 
estimee, et en fonction de parametres caracteristigues 
d'une reponse du capteur de position angulaire* 

Le dispositif de 1' invention peut comporter un 
ou plusieurs capteurs de position angulaire sensibles a 
la gravite et un ou plusieurs capteurs de position 
angulaire sensibles a un champ magnetique. 

De faqron plus generale, d'autres capteurs sont 
susceptibles de donner des informations sur leur 
position angulaire par rapport a une direction de 
reference de 1 ' espace . 

Par exemple, il existe des capteurs aptes a 
mesurer un gradient de temperature, un gradient de 
pression, des capteurs d ' image (visible ou thermique) . 

A titre d'exemple, le capteur sensible a la 
gravite peut comprendre au moins un accelerometre et le 
capteur sensible a un champ magnetique peut comprendre 
au moins un magnetometre . 

Afin de mesurer la position angulaire de fa^on 
la plus complete et la mieux determinee, le dispositif 
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est de preference equipe de deux capteurs ayant chacun 
trois axes de sensibilite. 

L' invention concerne egalement un dispositif de 
capture du mouvement de rotation d'un solide comprenant 
un dispositif de capture de 1 ' orientation tel que 
decrit ci-dessus et des moyens pour enregistrer des 
estimations successives de 1 ' orientation du solide. II 
Skagit, par exemple, d'une memoire. Le dispositif peut 
comporter aussi une horloge pour cadencer 
1' enregistrement des estimations successives de 
1' orientation du solide. L' horloge permet egalement 
d'etablir des vitesses et des accelerations angulaires, 
si necessaire. 

Le calcul du mouvement peut avoir lieu dans le 
calculateur et selon des lois classiques de la 
cinetique d'un solide. 

L' invention concerne encore un precede 
d' estimation de 1 ' orientation d'un solide comprenant 
les etapes suivantes : 

a) la saisie d'au moins une donnee de mesure en 
provenance d'au moins un capteur de position 
angulaire et 1 ' etablissement d'au moins une donnee de 
test representative d'une orientation estimee du 
capteur, 

b) la confrontation de la donnee de test et de la donnee 
mesuree , 

c) . 1 ' etablissement d'au moins une nouvelle donnee de 

test representative d'une nouvelle orientation 
estimee du solide, corrigee en fonction de la 
confrontation precedente, 

d) la repetition des etapes b) et c) . 
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On peut itSrer les etapes b) et c) jusqu'^ ce 
que la confrontation revele une difference entre la 
donnee de test et la donnee de mesure inferieure a un 
seuil determine. 
5 La confrontation des donnees peut comport er 

leur comparaison ou le calcul d'une difference, comme 
indique precedemment . 

L' invention se distingue des dispositif s de 
I'etat de la technique par le fait que la determination 

10 de 1' orientation ne se fait pas necessairement dans un 
temps constant. Dans les dispositif s de I'etat de la 
technique, la determination de 1 ' orientation est 
effectuee dans un temps fixe correspondant au temps de 
calcul necessaire. Dans le cas d'une confrontation 

15 iterative telle qu'indiquee ci-dessus, le temps pris 
par la determination de 1 ' orientation est, par exemple, 
1±€ a la pertinence de 1' estimation initiale de 
1' orientation et la vitesse de convergence des 
estimations successives. En d'autres termes, le temps 

20 mis pour la determination de 1 ' orientation depend du 
nombre de repetitions des etapes b) et c) . Le temps de 
traitement ne constitue toutefois pas un obstacle pour 
la mise en CEuvre du procede . En effet les mesures 
reelles effectuees ne sont en effet que de I'ordre de 

25 500 par capteur et par seconde . II est ainsi possible 
d'effectuer plusieurs boucles d' estimation pour chaque 
mesure. Le nombre de boucles est en general inferieur a 
30. Souvent, quelques boucles suffisent. 

Comme indique precedemment, lors de I'etape c) , 

30 on peut effectuer un calcul de correlation selon une 
methode de descente de gradient d'erreur. Bien que cela 
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constitue une solution moins preferable, il est encore 
possible d'effectuer des estimations aleatoires. 

D'autres caracteristiques et avantages de 
1' invention ressortiront de la description qui va 
suivre, en reference a la figure du dessin annexe. 
Cette description est donnee a titre purement 
illustratif et non limitatif. 

Description detaillee d'un mod e de mise en (Euvre — de 
1 ' invention. 

Les references 10a et 10b indiquent 
respect ivement un accelerometre et un magnetometre . II 
s'agit de capteurs a trois axes de sensibilite, de type 
connu, susceptibles de delivrer des donnees de mesure 
representatives de 1 ' orientation, c'est-a-dire d'une 
position angulaire d'un solide S. Le solide S est 
indique sommairement en trait discontinu. II s'agit' par 
exemple d»une partie du corps humain dont on veut 
apprecier les mouvements, une souris inf ormatique , un 
outil chirurgical, .... 

Lies mesures des capteurs, notees ©m, sont des 
grandeurs scalaires ou vectorielles . Elles * sont 
representatives, par exemple, d' angles de lacet, de 
roulis et de tangage ((p,v};,0). 

Ces mesures sont dirigees vers un comparateur 
12. II s'agit, dans 1 Vexemple il lust re, d'un 
dif ferenciateur . L.e comparateur 12 reqoit aussi une ou 
plusieurs donnees de test ©c delivrees par un 
calculateur 14 . La donnee de test peut etre de type 
vectorielle et exprimer des angles selon plusieurs 
axes. Le calculateur 14 est utilise comme moyen 
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generateur de donn^es de test. Les donnees de test sont 
representatives d'une orientation estim^e du solide qui 
peut etre aleatoire ou non. II s'agit, par exemple, de 
triplets d' angles de lacet, de roulis et de tangage 
{9,viy,e) . Le calculateur peut etre localise sur le 
solide S. 

Le comparateur d^livre une difference A©, qui, 
selon un ou plusieurs axes, repr§sente un ecart entre 
1 ' orientation r§elle, correspondant a la donnee de 
mesure, et 1 • orientation estimee correspondant a la 
donnee de test. Get €cart est utilisable pour af finer 
1 • orientation estimee du capteur, et done du solide 
auquel il est fix6. 

Toutefois, il est possible de fixer un seuil th 
en dela duquel on considere que 1 • orientation estimee 
est suf f isamment proche de 1 ' orientation mesur^e pour 
etre valid§e. Ceci peut avoir lieu au moyen d'un 
deuxidme comparateur 16 pr4vu pour comparer la 
difference A© avec la valeur de seuil th. 

Lorsque la difference est inferieure au seuil 
en valeur absolue la donnee de test ©t, c ' est-a-dire 
1' estimation de la position angulaire est dirigee vers 

une sortie O. 

En revanche, lorsque la difference est 
superieure au seuil, elle est dirigee vers le 
calculateur 14 pour effectuer une nouvelle estimation 
de la position. Les comparateurs 12 et 16 constituent 
ainsi avec le calculateur 14 des moyens 18 de 
modification de 1 ' orientation estimee du solide 5. 

La nouvelle estimation peut §tre aleatoire. 
Elle peut aussi etre affinee selon un calcul de 
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correction par la m§thode de descent e de gradient 
d'erreur. Cette methode, connue en sol est illustree 
par le document (4) dont les coordonnees sont precisees 
a la fin de la description et auquel on peut se referer 
pour completer 1 ' expose . 

Le deuxieme comparateur peut eventuel lament 
etre elimine. Dans ce cas, la valeur estimee est 
continue llement affinee jusqu'a la saisie d'une 
nouvelle valeur de me sure . 

Le dispositif de la figure comprend des moyens, 
par exemple une memoire, pour enregistrer les valeurs 
estimees successives, valideeis, en fonction de mesures 
successives de la position angulaire du solide. La 
memoire M peut faire partie du calculateur et peut etre 
localisee sur le solide S. Les valeurs successives 
permettent de calculer le mouveraent de rotation du 
solide de meme que ses vitesses et accelerations 
angulaires. 

La saisie de valeurs de mesure par les 
capteurs, et 1 ' enregistrement des valeurs estimees dans 
la memoire M peuvent etre cadences par une horloge H. 

DOCUMENTS CITES 
(1) 

US-5 953 683, "Sourceless orientation sensor" de 
KOGAN Vladimir et al . 

(2) 

— US-6 702 708, "A miniature, sourceless, networked, 
solid state orientation module" de Christopher 
Townsend et al - , MicroStrain Inc. 2 94 N. Winooski 
Ave., Burlington, VT 05401, USA 
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(3) 

"A miniature, sourceless, networked, solid state 
orientation module", de Christopher Townsend, David 
Guzik, Steven Arms, MicroStrain Inc., 294 N, 
Winooski Ave., Burlington, VT 05401. USA, pages 44 
a 50. 

(4) 

"Methode de calcul numerique" de J. P. NOUGIER, 3®"^ 
Edition 1987, Edition MASSON, pages 54-58. 
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REVENDICATIONS 

1. Dispositif de capture de 1 ' orientation d'un 
solide comprenant : 

- au moins un capteur (10a, 10b) de position angulaire, 
susceptible d'etre rendu solidaire du solide et de 
delivrer au moins une donnee de tnesure (0m) 
representative de 1 ' orientation du solide, 

- un moyen (14) generateur de donnees de test (©.t) 
representatives d'une orientation estimee du solide, 

- un moyen (18) de modification de 1' orientation 
estimSe du solide par confrontation de la donnee de 
mesure et de donnees de test . 

2. Dispositif selon la revendication 1, dans 
lequel les moyens (18) de modification de 1 ' orientation 
estimee comportent un premier comparateur (12) relie au 
capteur (10a, lOb) et au moyen generateur (14) , pour 
recevoir la donnee de mesure et au moins une donnee de 
test, et pour etablir au moins une difference (A©) 
entre la donnee de test et la donnee de mesure. 

3. Dispositif selon la revendication 2, 
comprenant en outre un deuxieme comparateur a seuil 
(16) pour comparer la difference etablie par le premier 
comparateur (12) a une valeur de seuil (th) et pour 
valider 1 ' orientation estimee, lorsque la difference 
etablie par le premier comparateur est inferieure a la 
valeur de seuil . 

4. Dispositif selon la revendication 1, 
comprenant au moins un capteur de position angulaire 



B 14009. 3/EW 



2838185 

15 



(10b) sensible a la gravit§ 
position angulaire (10a) 
magnet i que . 



et au moins un capteur de 
sensible a un champ 



5. Dispositif selon la revendicat ion 4, dans 
lequel le capteur sensible a la gravite comprend au 
moins un accelerometre et le capteur sensible a un 
champ magnetique comprend au moins un magnetometre . 

6. Dispositif selon la revendication 4, 
comprenant deux capteurs ayant chacun trois axes de 
sensibilite . 

7. Dispositif selon la revendication 1, dans 
lequel les moyens (14) g^nerateurs de donnees de test 
comportent un calculateur pour calculer des donnees de 
test en fonction d'une orientation estim^e, et en 
fonction de paramdtres caracteristiques d'une reponse 
du capteur de position angulaire. 

8. Dispositif selon la revendication 1, dans 
lequel le calculateur est localise sur le solide. 

9. Dispositif selon la revendication 1, dans 
lequel les moyens (18) de modification de 1 ' orientation 
estimee et/ou les moyens generateurs d'une donnee de 
test comportent un calculateur pour etablir une 

^ouvelle orientation estimee et/ou une nouvelle donnee 
de test selon .une methode dite de descent e de gradient 
d' erreur . 
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10. Dispositif selon la revendication 9, dans 
lequel le calculateur est localise sur le solide. 

11. Dispositif de capture du mouvement de 
rotation d'un solide comprenant un dispositif de 
capture de 1 ' orientation selon I'une quelconque des 
revendi cat ions precedentes et des moyens (M> pour 
enregistrer des estimations successives de 
1 ' orientation du solide . 

12. Dispositif selon la revendication 11/ dans 
lequel les moyens (M) pour enregistrer sont localises 
sur le solide. 

13. Dispositif selon la revendication 11, 
comprenant une horloge (H) pour cadencer 
1' enregistrement des estimations successives de 
1 ' orientation du solide. 

14. Precede d' estimation de 1 ' orientation d'un 
solide comprenant les etapes suivantes : 

a) la saisie de donnees de mesure en provenance ' d' au 
moins un capteur de position angulaire (10a, 10b) et 
1 ' etablissement d'une donnee de test representative 
d'une orientation estimee du solide, 

b) la confrontation de la donnee de test et la donnee 
mesuree , 

c) 1' etablissement d'une nouvelle donnee de test 
representative d'une nouvelle orientation estimee du 
solide, corrigee en fonction de la confrontation 
precedente. 
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d) la repetition des etapes b) et c) . 

15. Precede selon la revendication 14, dans 
lequel les etapes b) et c) sont repetees jusqu'a ce que 

5 la confrontation revele une difference entre la donnee 
de test et la donnee de mesure inferieure a un seuil 
determine. 

16. Procede selon la revendication 14, dans 
10 lequel lors de I'etape c) , on effectue un calcul de 

correction selon une methode dite de descente de 
gradient d ' erreur . 

17. Precede selon la revendication 14, dans 
15 lequel la confrontation des donnees de test et de la 

donnee de mesure comprend 1 ' Stablissement de donnees de 
difference ( A® ) entre des donnees de test successives 
et la donnee de mesure . 

20 18. Procede de capture de mouvement d'un 

solide, caracterise en ce qu ' on repSte le procede selon 
la revendication 14 avec des donnees de mesure 
successives . 

25 
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